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FOR TACTICAL AIRCRAFT GINBALLED IMU 
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Figure 6.5. 
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Addition of Actual Measurements 


Figure 6.6. 
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Development and recording of a representative flight. a 
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Development of HUD display for the flight 


Collection of WMS pointing statistics ~~~ 
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4a) Imo oe 
4) Attitude 
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Step 7 Full simlation 
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The Map Displacement Generator utilises the pore of the Its : ‘ q 
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‘The order of presentation of the wode 21st “lie follow the flow ef the 
Jogte Tn Figure 1.2. > Tatar, ‘tte OWE: Water’ k dvthemetical order wes chosen). 
“therfore, ‘the foTiowtng Tist Uf covvetetions between Figure 1.2 and the 
subsections of Section 2.whth be -kelefutita the swader: 

_ Unittalize: Section 2. 24.5 Oe 1533 
Trajectory Calculation: ‘Seetton ‘2.5 
Calculat,. F +6293, Section 2.4. AS ; 

Propagate to TOTP: “Section 2. * 
Output: Section 2.6 
Calculate-HaR: Section 2.4.4 
Kalman. ‘Update: . Section 230° = 


Throughout this section; an " erroe quantity: is described as the computed — 
(or observed) values minus: the: true ‘value of the’ quantity. All of these 
errors are considered as readom. vartables ands. therefore, (since ‘thay are time- 
dependent) as stochastic or 
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2.2 Linear Error Model Equations. 
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where ¥ git) end w(t) are stationary continuous al becontaa processes. In 
gost soos. a model of this, form arises naturally, but.in others (the: main 

- quample is gravity. anomaly). another form of pode) (2, ae pihoeetae hn 
arises more naturally. In these latter cases, an . approximating wih te-ng 
forced. made] must he derived. 


2.3. Cpvartance Calculation (Propagate And.Update,P) ing 4 
The covariance propagation method is based upon: the -fol lowing eeeumpti ons : 

the information about error states provided by external measurements is in- 
corporated by means of a Kalman filter.. This procedure: allows: for a ealeu- 
Vation. tm the navigation. computer, of 4 running estimate, A, of the error 
state vector. Z(¢),.which is used to correct, the {ndt cations. Mn posttton, 
velocity, end attitude provided by the. fyertia) cpavtgete = o 

_ equasions used wil) not be repeated heres .. refer, to, Chapter 4. 
of Applied, Optinel Estimation ed. by A. aid, ‘at. a) arficulerly,f8 = 

_ tables on Page 110 and 123,*. Mentign should be wade.of dhe, fact. that. 
Kalman-f1 iter. assumptton {s an idealization since such an atgord the would be 
too umvieldy for IMU computers. However, the assumption te werenited-by the 
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:  wivtele 42. fabended..to. apornech.eptinn) ity, within, rea)isnic.o¢ wast ong: constraints 

In stillying ‘the probegetien: of arrore tireuyh the qalitence:-aguten via 
_* covariance aiiilysts’, ong otuarriec aclaeieee wentettelt oh akoniariance 
vie or tatined by 28) amod a parigéed ot cadmas we 


H(t) = He) ad x(t) ne 4a @ To prt nn pe 
p(t) = * EERE “(0)) tt, 


¢ a: aa *- * 
discrete, 


ewe cote te wn Aabenmened 01 STENT EE, a ELT TT an oa ee + «one sliempaes = =o = = oe a 


Thani 1t. ange be: shaw: thet: batemen: Measurement 
| Riasett: 4i¥ ferent tad: nquagton: 26 hii) 0 edo 8) 
| oo a Rg ome RB ROY APS 
(Alternatively, the propogation of dive, can be represented 
by uk? fr) ku = tz! . 
‘Ptent) ~ Peer HK : ms witha”? 


where a discretized form of. th jrncens An iemihovesy a update of, the ft 
covariance As given mS, 


ee 2), "i oveie = 
Pty!) = Cog) AE: so eseet BP 

where Ky 1s the Kalman gain matrix. att of these efeitos ae 

{n full detail in Ref. 2. 0° oF GR Fea TB . 


nis ph A Dade Sears? 


| 
; | Of course, the calculation of a(t) using the equations presented. above 
can only be accomplished {¥ the system and méasufesient wititxas: ete kin. 
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‘2h Guidance Error: Hodel nisériptson ita « te Pe 
The preceding section discutsed error covariance jidediartes' hig + Vineer 
systems in general. The guidance subsystes error mitel (tacludtay ‘he ade 
for gravity: anomalies which effect it) 1s a ltnbar’ system: of the: thew = 
Poe, describéd in Section 2.2. Before the specific charactertatics ‘td Gyelinics 
| of the guidance subsysten error model are described, 1t*1s Convenient. ® 
: 3 tntrotuct ‘the coord nate fremes in witch the quantt tes. of” hiterest até’ a 
nn hE %. n gree hs 
2.401 Coordinate. Frees gba & ig Up ah Afar Lag 
“In this section, the coordinate: frames to be + ant tte 3 ‘big ore 
“ describéd. The three exes of tach of these Tremes: fete a Mgnt ‘ hath sat, 
—e de: the center: of, the earth:;,; : tore sos " igh gt tam 


beginning of a mission. 


GD tweet a -equatorta Frais {45 trim} THEE se ¢ frame ta stitch 
the ‘trajectory Gositton, vetoci ty,” she’ sbect te fortes WATT teryhnnly we] 
meri datd for miasureneiit, beacons OF Venimrks and tetbedeers cal, y! 
Ite in the equatorial plane with’ x! ‘thFOugH the’ Greenwich mertdten at teh, The 
ai axis points to the North Pole. T The Eel is inertial. 


(2). ‘Earth-Frame (e:frame). “This frome: cotnetdes with the ‘cteene. 
at t=O but is fixed relative to the earth. Thus... ft retates about 2! at 
. rate no ‘ 


: (3). Geographic eee ce “This ies has its axes aligned 
with north, east and down directions at the present location (time t) of the 
vehicle. It is a natural frame in which to express the rms output errors. 
This frame rotates with the earth and the vehicle. 


(4). Flight-path® frame (t-frame).. This frame is used to specify 
gravity models. The geographic frame is rotated. about the z axis, so that the 
x axis points in the vehicle direction of flight. Thus, the x* and y* axes 
form an along/cross track reference system. : 


, (5). Platform-frame (p-frame). This frame is a natural one for 
specifying the errors in inertial instruments. The axes are the output axes 
of the accelerometers, with the xP, y? axes paraltel to the platform. 


2.4.2 System State Vector 


This section presents the physical meaning of the elements of. the state 
vector X(t) in the linear error model equation. The basic form. of the 62-— 
dimensional vector ts 


R(t) = (Brot). F(t) H(t) a(t) a(t) Xe(t), gt) He p(t] 


In this equation, dr and dv are 3-dimensional position and velocity errors in 
{ the {- “trem, and @ {s the 3-dimensional platform misa}ignment (att tude) error 
a vector, ‘coordinatized in the i-frame. 


The following paragraphs describe gyro and acceterenater errors. These 
errors are modelled in accordance ha and we one serettes of, Ref. 3. 
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. | (In these saa ciena’, the syaBols I, 0, and S refer the jaedosinadaieik 
| axes of the gyro). Similar definitions hold for ud), through: day with: all 
o these drift biases. assumed to be statistically independent. | 
The -15-dimensional vector a(t) represents the accelerommter errors, | 
The input axes of the three accelerometers are along the platform %,%.Z axes ! 
respectively.. The first 4 elements of a(t) are defined as follows: Lod 


: a, = K, = bias error au 

Pe , S : E ; 

i it i ao = Kry © scale-factor error corftictent. 2 | 
a5 = Kis * scale-factor non-lingarity cotta 4 
ag * Keg * = cross-axts nori-Tineartty, coettct clint : 
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: Elements 5 through 12 of are similarly defined with reference to the Y" | 
and Z accelerometers. Elements 13 through 15 represent meee eich 
—ae = ical a a ae A ee 
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Xgq = anomaly magni tude/g,, | 
where gy" average surface gravity. (The scaling of the latter by g is 
merely a convenience). = 


The remaining states refer to the altitude damping based on altimeter 
measurements. Third order damping is assumed (as in Ref. 4), and this gives 
rise to three damping states, one for each {-frame axis. The ‘threesdimens ional 
vector Xq(t) represents these states. (The 6a notation of Ref. 4 15 not used 

to avotd confuston with accelerometer errors). The two-diains fonk) | vector 


Shee represents altimeter errors, and is defined as | aa 
s Shee} * Ist order Markov error arg 
Oraf 2° bias error ous ) 


This completes the description of the error-state vector. 
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2.4.3 System Matrices (F, 6. Q) ee 
ig’ BF 


The system matrices describe the fundanenta}.serap mans of the WM. ns 

The matrices defined here are based on three sources ef fafprantion: 
Space-stable IMU dynamics (Ref. 1) a 8 | 
Third-order altitude damping (ters “@) 6 es 4 
Inertial-instrument error models SRef. 3) | 


The reader of this memorandum desiring -detatied:: iacanecdestion ‘Ot the wim 
matrices should refer to these sources. 


The dynamics matrix F(t) has dimension 62 by 2, in accordance with 
the dimension of the error-state vector i(t). F(t) ts presented in partitioned 
form as: > 
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where Ri(t) is i-frame gestion: (These quantities wilt be used ‘frequently 
in subsequent equations). Then 


where is is a damping coefficient. # att) 1s 3 by 2, eee the 
effect of altimeter errors. The definition is 

Fy alt) s k, [tip : Up]. 
(The colon signifies justaposition of matrices) . 4 ae aes, Sos 

Fo y(t) 1s 3 by 3, and is defined as cae 
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where w(t) is the Schuler frequency: 
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Ce 4.84814x10"°: red/sec 
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FD | (t) reflects altitude damping sind 1s deftoed 


FD (ty emu _ artanght e We = gb 


where kp 1s 2 damping coeffictent. a cee 
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"The LA a) matrtx is 3 by 3, ‘end nd ede 9 i wert tnt cated accel 
eration eae by platform alignment errors? We Mistgnate: ‘wy At} the 
specific force acting on the instruments . Then 
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The matrix Fo, 5(*) is 3 by 15. This ees models the aceslevatton 
indication errors (bias, g-sensitive, etc). (For further explanation, see 
Ref. 3). To describe thts matrix, we let... 


7°(2) = cP #! (t) 


where Cf is the transformation from the 1-to the: D: frome. (hig. be a 
program input representing nominal platform aclentarioe)- Then dropping 
the t's for convenience: 
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The matrix F, g(t) reflects the affect or grivity anomaly on 53 
errors. It is given by:. ee 
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Fo,6(8) * Sy Ce | 

where on is average gravity at sea-level. Note that the t to i trensformetion 
1s time-varying. It will be provided by trajectory calculations. | 


z(t) is 3 by 3, and is part of the altitese damit dyrantes. 
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F 2,9(¢) is 2 by 3, rerlectiag the effect of altimeter errors. It 
is defined . : 
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where Beoay is defined above (F, ‘(t)). and ‘a is the aes deflection 
Standard deviation and cay, 1s the anomaly (iignitude) standard’ diviatton.* 
Define 


G4 * But Suton 


where By. 7 is the time cons‘ant of: the altimeter Markov error, 904°C, 7» 
4s the standard deviation of this same error. . 


The G matrix 1s 62 by 4, and inputs the wiite driving noise into the 
gravity and altimeter error models. It is defined as follows: 
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This completes the description of all of the error wade} system matrices. 
It is to be noted that the variables used in —— these matrices are: 
* umerical parameters for testrymes:, and ett error macins 
* Position and specific force in therttal 1; se 
* Coordinate transformation matrices. a eee 
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2.4.4 hnsurdaent Matrices (H.R) snort .eeen 


The COM program uttizeg, typ fundamental classes ¢ extarne’: i tes, 
For the tactical application a maf eae to kfltw landmarks has’ San: 
added to the COM program. We: note that the calculations require the fot how 
tag inputs: 
aa > ‘Ped Tt ton and ‘velocity’ In rene: Po J uple|re Sl tes 
". Thee into wissfon, to calculate iframe location @ of Taf ‘Stations 
. Standard deviation of updata-station ephemeris errors. 


2.4.5 Inttial Covartance Matrix 


In solving the Ricattt differential equation (Section 2.3.1) for 
P(t) a value of P(0) is required. | This represents the covariance matrix 
of errors states prior to takeoff.* 


However, the P(0) ts itself a result of the errors fh complex: initial 
calibration and alignment procedure. The actual P(0) matrix will depend 
heavily on the particular mechantzation of this procedure, on the time alloted 
to the procedure, and other factors. At the time of this writing, study in 
this area is still in progress. This section presents a simplified model, 
based on the assumption of uncorrelated error-states.** 


P(O) is assumed dtagonat, with Py denoting the 1-th diagonal element. 
The first 9 of these are 


P,* 0 i=1 through 6 


P, = Lolvp)]#t = 7,8,9 


where o(¥)) 1s the ras initial altoment error per axis. The next F) terms 
are defined in terms of standard deviations of the gyro errors d;. 191 92520200 
Visted in Section 2.4.2. 1¢ {8 actumed that these standard devietions are 
the same for all three gyroscopes, so that only ten standard deviations, 


* The value of P(t) at the Segtnnt of_ce Totter and Pass te stanly the 
terminal velue from the: preceding phase. : ‘ 


**for a gimbal-memory altgnment system this assumption ie fatrly realtstte. 
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The next 15 diagonal elements. represent acculonaptar seners- The accelerometer 
standard deviations are given as o(a,), 191.2 03,4 and o(8), where 6 is the 
mounting error misalignment. Then define . 2 
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The next three (gravity anomalies) are 


Peg * Peg * Syp: 
P57 * (Spnow/9y)” 


= standard deviation of vertical deflection .” 


’ Pyp 


OANOM 
ny = nominal gravity 


= standard deviation of gravity anomaly. 


Corresponding to the damping states, 


i Pap * Pao = Pe = 0 Pe ote | 
Finally, the altineter © errors are intetalized | by eee - ‘ 
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This completes the sesrtnciee had the’ tntenay ” _— ee 


= oye 


2.8 Trajectory Calculations tet a ae 
2.4.4, and 2.4.8Y Wikis sueanee aan eee ian. 

of required dita, ‘at ony: ‘wiven — 4s: Toren Sr Fegeqes aac m 
ry «; {-frame sista: a 
V' = {-frame velocity 


i = i-frome spacific ‘force 


"g = ground speed. 
Cs ¢ 7 direction cosine-matrices 


The equations for calculating these are not reproduced here. Obviously 
they will be different for the several phases of amtssion. 


The loiter-phase trajectory fncludes some segments with sharp turns, 
where system-dynamics vary, and some long straight segments, where they are 
stable. Therefore a flag wil) be output to jfndtcate, for the gtven time, 
which of these segment types the missile is located on. Such a fiag will 
not be required for the other phases. 


2.6 Output Calculations “Malo yyetsobea’ as 

There are two classes jibes oearnik. whe frat. the 
deviation of major TW errors, presented asa function of tise. The second 
is the complete covariance matrix et the end of the Nets vac ts to be 
ueed ' to inieielie ‘me. succeeding ee: ae 


ce er erate en ret 


The IMU errors of interest are position, velocity and alignment errors 
coordinatized in the { and n-frames. (Velocity is with respect to inertial 
space, regardless of the frame it is coordinatized in). Partition the P 
matrix at time T as 


tT 


in which all the sub-matrices are 3x3, and the spaces are not of interest 
i here. Then 
a 

| 

| 

| 

\ 
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o(8r!) = Pa(asa) , aF7,2,3 
o(8v") = Py(a,a) P a=} 929 
oly) )= Py (a.a) » 28] ,2,3 


wher. eel, a, 3 are i-frame IMU errors. Next calculate 


n n | 
Pa Pe CG, 


{ i 
yo Cp Py Cy 

| 

° = Cf Peon 

Then the n-frame outputs may be calculated from these matrices just as in the 
case of the i-frame outputs. Both sets of standard deviations may be calcu- 

lated naieapanted fn time from the current P(t) matrix. 


The second output is simply the entire P matrix at the ond of a al - 


and entree no further discussion. Se aT a 
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